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An innovative approach to autonomous attitude and trajectory estimation is 
available using only magnetic field data and rate data. The estimation is 
performed simultaneously using an Extended Kalman Filter, a well known 
algorithm used extensively in onboard applications. The magnetic field is 
measured on a satellite by a magnetometer, an inexpensive and reliable sensor 
flown on virtually all satellites in low earth orbit. Rate data is provided by a 
gyro, which can be costly. This system has been developed and successfully 
tested in a post-processing mode using magnetometer and gyro data from 4 
satellites supported by the Flight Dynamics Division at Goddard. 

In order for this system to be truly low cost, an alternative source for rate data 
must be utilized. An independent system which estimates spacecraft rate has 
been successfully developed and tested using only magnetometer data or a 
combination of magnetometer data and sun sensor data, which is less costly 
than a gyro. This system also uses an Extended Kalman Filter. Merging the 
two systems will provide an extremely low cost, autonomous approach to 
attitude and trajectory estimation. 

In this work we provide the theoretical background of the combined system. 
The measurement matrix is developed by combining the measurement matrix 
of the orbit and attitude estimation EKF with the measurement matrix of the 
rate estimation EKF, which is composed of a pseudo-measurement which 
makes the effective measurement a function of the angular velocity. Associated 
with this is the development of the noise covariance matrix associated with the 
original measurement combined with the new pseudo-measurement. In 
addition, the combination of the dynamics from the two systems is presented 
along with preliminary test results. 
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INTRODUCTION 


Most missions supported by NASA have an attitude and orbit determination 
requirement. In most cases, the attitude estimation is performed onboard the satellite. 
However, the orbit determination is performed primarily on the ground post pass. Efforts 
are underway to provide for spacecraft onboard autonomous orbit determination. 
However, these efforts are somewhat expensive and have limited availability which makes 
them less attractive to the multitude of missions being launched with very modest attitude 
and orbit requirements as well as modest budget. Up to this point their options were quite 
limited due to the expense of space qualified attitude determination hardware as well as 
the expense of ground based and GPS based orbit determination. 

In this work, the EKF used to estimate the orbit and the attitude is expanded to 
include the estimation of the rates. The effective measurement used by the EKF now 
includes the difference between the observed and expected magnetic field and the 
derivative of this difference. A corresponding noise covariance matrix is developed. The 
combined filter dynamics are straightforward and requires input regarding external 
torques on the spacecraft. Results from simulated data are presented following the 
theoretical background of the EKF. 

The resulting system is expected to provide low cost navigation, i.e. attitude, orbit, 
and rates, for low earth orbit satellites. The system relies on existing hardware, namely, 
magnetometers, sensors that are carried on virtually all low earth orbit satellites. There 
has been only 1 reported failure of a magnetometer for missions supported by 
NASA/GSFC. Sun sensors, if used, are also extremely reliable. Both sensors are 
currently available and most importantly, they are flight qualified. Comparable systems, 
such as GPS, are considerably more expensive and flight qualified receivers are not readily 
available. Any mission, whether commercial or government, with coarse accuracy 
constraints or desiring an inexpensive backup method for attitude, rate, and orbit 
estimation can use this system, provided the satellite has an onboard computer. The impact 
to the onboard processing will not be significantly more than current onboard processing 
and can easily be accomplished with current computing technology. Furthermore, utilizing 
onboard processing reduces the cost of ground operations. Overall, this is an innovative 
approach for a low cost, coarse attitude and trajectory estimation system. 

THEORETICAL BACKGROUND 

Following is a summary of the EKF algorithm. The assumed models of the EKF are 
given as: 

System Model: 


X(t) = f(X(t),t) + w(0 


( 1 ) 



Measurement Model: 


Zk=hk(X(t k ))+rik 


( 2 ) 


Update Stage 

The linearization of equation (2) results in 

zk = H k Xk + Uk (3) 

where H k is the measurement matrix of the new, combined filter. H k is composed of sub- 
matrices which reflect the dependence of the effective measurement z k on the state vector, 
Xk which contains the orbital elements, the attitude quaternion, and the angular velocity. 

Xk T = [a, e, i, O, w, 0, C d , g, ©] 


where: 

a = semi-major axis 
e = eccentricity 
i = inclination 

Q = right ascension of ascending node 
w = argument of perigee 
0 = true anomaly 
C d = drag coefficient 
q = attitude quaternion 
to = rotation rate 

The measurement matrix is 


H k = 


H 0 H a 0 
0 0 [bx] 


( 4 ) 


Where Ho and H a are the submatrices reflecting the dependence of the orbital components 
and the attitude 4 , respectively, on the effective measurement. The matrix [bx] is a skew 
symmetric matrix composed of the elements of the measured vector, b. The development 
of the dependence of the angular velocity on the effective measurement follows. 

The effective measurement, z k contains two elements, Zi and z 2 . The first is the 
difference between the measured and computed vectors 1 and the second element is the 
difference in the derivatives of the measured and computed vectors 2 . Taking the 
derivatives of the computed and measured vectors brings in a dependence on the angular 
velocity through the formula: 



where: co = angular velocity vector 

r_= reference magnetic field vector resolved in inertial coordinates 
Dq = transformation from inertial to body coordinates 
b = observed magnetic field vector resolved in body coordinates 

Incorporating the noise into the reference and observed magnetic field vectors, (5) can be 
written as 


b-Djr = [bx]co +[r] b x]o - tj. +dJt]. (6) 

where a b = measurement vector noise 

Hi, = Oil* - r|i,k.i)/A 

r|. = reference vector derivative noise 

— r 

[b x] = anti-symmetric matrix composed of the elements of b, which is entered 
into H above 

A = time between measurements 

The second element of the effective measurement is then formally defined as 

z 2 = (b - Dl, r) - [b x]oo ^ (7) 

Where ©est is the current estimated rate. 

Assuming the noise from the reference vector to be zero, the noise terms in (6) can be 
combined into 


% = [-© x ]n b ” 3b (8) 

The measurement noise, rjb is augmented with the noise Tja into the noise vector, tj, of (3). 
In order to use this in the filter the covariance matrix R is computed as 



( 9 ) 


If the magnetometer is calibrated such that the measurements have no bias E{r]i } and 
E(Ud} are zero and R becomes 



E{n,Y}- 

eky; 

1 %Vl 


( 10 ) 



The matrix E{2 i T n/} is the noise covariance matrix for the magnetometer measurement. 
Based on the assumption that the rji.k and 2 i.m are uncorrelated, the E{rj<] 2d } 
becomes 


E {l!d!!d T } = DR tam° T +(U A 2 )R tam 
T he matrix D is computed as 


( 11 ) 


D = [(5 x] + (l/A)I 

The noise covariance matrix then becomes 

_ R-TAM RtamD 

~[-DR tam DR tam D t +( 1/A 2 )R tam _ 


( 12 ) 


(13) 


The update of the state vector and covariance matrix is performed using the standard 
EKF equations 

x*(+) = x k (-)+K ka ( 14 > 

Pk(+) = (I-K k H k )P k (-)(I-K k H k )+R k (15) 

where the gain matrix, IQ is computed as 

K k =P k (-)H k T (H k P k (-)H k +R k ) (16) 

The state vector, x, given in (14) is the internal state used by the EKF. This form is used 
internally to estimate the angular error in the attitude (in addition to the other state vector 
elements) which is then converted to the quaternion given in the state, X, above. This is 
the so-called ‘multiplicative’ approach 4 . 


The above derivation is valid for a magnetometer. For another sensor, such as a sun 
sensor, the following changes must be made. First, since another sensor is not influenced 
by the orbit, the measurement matrix in (4) is replaced with 


H k = 


0 H a 0 ' 
0 0 [b x] 


(17) 


where b is the measured vector. The effective measurement, z, is based on the sensor 
measurements of the given sensor and is computed as for the magnetometer. The 
computation of R is as given in (13) with R T am replaced with the noise covariance matrix 
of the given sensor. Based on the results of Reference 4, the 3 rd and 6 th rows of H k in (17) 



above and the corresponding rows and columns of R are removed. This is to prevent 
singularities from a line of sight sensor 

Propagation stage 

The propagation of the state estimate, based on equation 1 is performed as 

X = f(X(t),t) (18) 

The updated estimate of the state vector, X k (+) is propagated from time t k to t k +i by a 
numerical solution of the continuous dynamics. The orbital dynamics are non-linear and 
describe a central force including both J2 effects and drag 3 . The differential equation 
which governs the propagation of the quaternion is linear and is dependent on the 
estimation of the spacecraft rotation rate 5 . The spacecraft dynamics are used to propagate 
the rate estimate. The dynamics model of the spacecraft is non-linear and the method of 
solution is given in Ref. 2. 

The propagation of the covariance matrix is performed using the following 

P k+l (-) = A k (X k (+))P k (+) A k T (X k (+)) + Q k (19) 

where Q k is the spectral density matrix of rn(t) and Ak is the approximated transition 
matrix. Ak is computed using the following first order Taylor series expansion 

Ak = I + FAT (20) 

where AT is the time interval between the control data that is used to propagate the 
angular velocity. The Jacobian F is derived for the orbital dynamics in Ref. 3, for the 
attitude dynamics in Ref. 4, and for the spacecraft dynamics in Ref. 2. 

RESULTS 

The initial testing of the above EKF was performed with simulated spacecraft data. 
The spacecraft in the simulation is the Rossi X-ray Timing Explorer (RXTE) satellite. 
Table 1 specifies the true state, the initial state used by the EKF, the initial covariance, and 
the initial RSS errors in position, velocity, attitude, and rates. The simulation is based on 
an actual spacecraft ephemeris, not a two-body propagation. The simulation contains 6 
hours of data, which is equivalent to approximately 3.7 orbits. Magnetometer and sun 
sensor measurements were generated every 2 seconds, without any noise. The spacecraft 
is inertially pointed in the simulation; there are no attitude maneuvers. Therefore, the 
control data necessary for propagation of the rate estimate is nominal. The measurement 
noise for the magnetometer and sun sensor are 0.01 degrees and 10 milliGauss, 
respectively. The relatively large value chosen for the magnetometer measurement noise 



is a result of previous testing of the EK.F for attitude and orbit estimation and only orbit 
estimation based on magnetometer data. 

Figures 1 and 2 show the errors in the position. Figure 2 shows the position errors 
with an expanded vertical axis. After 1 orbit the maximum position error oscillates 
between ±40 km, with an average of approximately 0 km. Figure 2 also indicates that the 
orbit has not yet converged. Due to the low inclination of the RXTE orbit, the orbital 
elements take a considerable amount of time to reach steady state as shown in Reference 
1. Figure 3 is a plot of the attitude errors about each of the spacecraft axes. The values 
oscillate between approximately ±1 degree. The average error is different for each of the 
three axes. Figure 4 shows the errors in the rate. The rate errors show a significant 
overshoot at the beginning and then slowly converge throughout the run. Errors in the 
rate contribute to the errors in the attitude estimate, this is evident in Figure 3. Additional 
tuning is necessary to determine if the final errors, and the size of the oscillations and 
initial overshoot can be reduced. Extending the length of the simulated data span is 
necessary. 


Table 1 . Truth Model and Initial Conditions 


State Variable 

Truth 

Initial State 

a (km) 

6956.7 

7156.74 

e 

0.00197 

0.002074 

i (deg) 

22.96 

22.5 

H (deg) 

109.74 

110.735 

w (deg) 

220.04 

225.036 

0 (deg) 

18.19 

28.19 

c d 

2.2 

0.000 

q(l) 

0 

0.0454 

q(2) 

0 

0.0416 

q( 3 ) 

0 

0.0454 

q(4) 

1 

0.99710 

© x (deg/sec) 

0 

0.001 

© y (deg. sec) 

0 

0.001 

© z (deg/sec) 

0 

0.001 


Initial 

Initial Errors 

Covariance 

10000 

0.0001 

1 

10 

RSS position error = 1948 km 
RSS velocity error = 2. 1 km/sec 

100 


100 


0 

01 § 

RSS attitude errror =8.8 deg 


(0.1) 2 RSS rate error = 0.0017 deg/sec 

(0.1) 2 

(0.1) 2 


*This is the apriori covariance of the angular error in the quaternion, see Ref. 1. This value is used for 
each component of the error. 



CONCLUSIONS 


The initial test results indicate that the EKF has the potential to simultaneously 
estimate a spacecraft orbit, attitude, and rates. Final position errors less than 40 km, 
attitude errors less than 1 degree, and rate errors less than 7e' 5 deg/sec resulted from the 
first test case based on the simulated RXTE magnetometer and sun sensor measurements. 
The initial test case consisted of clean, simulated magnetometer and sun sensor data 
covering approximately 3.7 orbits. Further tuning and additional data are necessary to 
reduce the final errors. 

Future tests will be conducted on noisy, simulated data based on an inertial attitude. 
Maneuvers will then be inserted into the data to determine if the EKF can detect and 
follow the maneuver. Finally, the EKF will be tested with real spacecraft data, ideally 
from a number of missions such as the existing RXTE, Total Ozone Mapping 
Spectrometer, Gamma Ray Observatory, Transition Region and Coronal Explorer 
(TRACE) and the future Wide Field Infrared Explorer (WIRE) mission. The final test will 
consist of a real time test onboard a spacecraft. 
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Figure 1. Position Error Components 



Figure 2. Position Error Components — Expanded Vertical Axis 






Figure 3. Attitude Error Components 



Figure 4. Rate Error Components 




